展开 罗德里格矩阵 坐标转换